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ABSTRACT 


In support of TNT experiments, the NFS UAV laboratory has developed a Vision- 
Based Target Tracking (VBTT) system for a Small Unmanned Aerial Vehicle (SUAV). 
This system provides an autonomous target tracking capability, while simultaneously 
estimating the target’s velocity and position. The accuracy of the existing system can be 
improved by providing external corrections to the target position estimation from the geo¬ 
rectification system (GIS). This thesis addresses the implementation of an asynchronous 
correction scheme into the target position estimation filter. The current autonomous 
position estimation algorithm provides 20-30 meters accuracy. The external correction 
system (Perspective View Nascent Technologies (PVNT)) is expected to provide target 
position accuracy of 1-2 m. However, a delay of up to 10 seconds is expected. Therefore, 
in order to improve the accuracy of current estimation of target motion, a new 
asynchronous correction technique that incorporates the more accurate PVNT data is 
proposed. To further improve the target motion estimation, it was also proposed to 
incorporate a known road model into the filter and compare its performance with the 
original filter. 
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I. 


INTRODUCTION 


A. OVERVIEW 

The main goal of this thesis was to design a new filter that is able to provide a 
better estimation of target motion. This new filter would complement the current non¬ 
linear target motion estimation filter mounted on a Small Unmanned Aerial Vehicle 
(SUAV). Naval Postgraduate School (NPS) is a participant in the Tactical Network 
Topology (TNT) field experimentation program, which includes United States Special 
Operations Command (USSOCOM), its component commands and several government 
laboratories. The field experimentations are part of the Surveillance and Target 
Acquisition (STAN) program. Quarterly field experiments are conducted at the Center for 
Inter-disciplinary Remotely-Piloted Aircraft Studies (CIRPAS) facility located at 
McMillan Field in Camp Roberts, California. These experiments aim to explore and 
demonstrate new technologies that are applicable to the military, with special focus on 
sensor and wireless network, autonomous vehicle and target tracking/identification. 

B. MOTIVATION 

The NPS SUAV is designed with Commercial Off-the-Shelf sensors that reduced 
the cost of operating the SUAV. The main role of the SUAV is in the surveillance and 
reconnaissance arena. 

The utilization of Vision-Based Target Tracking (VBTT) allows a passive mode 
of target tracking and reduces the risk of exposure of the UAV when it conducts its 
surveillance. This would enhance the security of the SUAV operation. 

Currently, the VBTT system utilizes a filter to estimate the position of the target. 
A coordinated control strategy is employed that estimates the position of the target using 
the turn rate of the Line-of-Sight (LOS) between the UAV and the target. 

The accuracy of the estimated target motion can be improved if an external 
correction is made to the estimated target position obtained from the current filter. One 
of the possible correction methods can be obtained from the Perspective View Nascent 
Technologies (PVNT). This technology will be described in more details in Chapter 2. 
The PVNT software is able to provide a correction to the estimated target position up to 1 
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meter accuracy. However, this updated target position would only be made available 
about 1 to 10 seconds later. Thus, there is a need to develop an asynchronous filter to 
incorporate this updated position. 

To further improve the performance of the new asynchronous filter, it is also 
proposed that a known road model be incorporated into the filter. The performance of 
this road-following asynchronous filter will be compared to the original filter to 
determine the anticipated improvement that may be achieved. 
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II. BACKGROUND 


A. PERSPECTIVE VIEW NASCENT TECHNOLOGIES (PVNT) 

The PVNT system was developed by Dr. Wolfgang Baer, a professor at the Naval 
Postgraduate School (NPS) in Monterey, California. The initial PVNT software was 
designed for tactical weapon testing. The software provided a 3D battlefield simulation 
and allowed the UAV to carry out target locating functions. The use of low-cost PC- 
based software helped to reduce the overall cost of the system. Currently, the PVNT 
software is capable of generating 1-meter-resolution terrain data for large area tactical 
battlefield simulations and uses it to create perspective views. These perspective views 
are employed to perform both line-of-sight (LOS) and weapon effectiveness analysis. At 
present, PVNT databases cover locations such as Fort Hunter Liggett, California and 
Camp Roberts, California. 

One of the more unique features of the PVNT program is the use of raster formats 
(pixel) as storage for terrain surface, as opposed to polygon database that is used by most 
scene-visualization programs on the market. This makes PVNT more suitable for 
handling data that is gathered by remote sensors, and ideal for integration with tactical 
battlefield sensor systems. 

Various experiments had previously been conducted at Camp Roberts 
incorporating flight test set-up with PVNT work stations. The flight test set-up utilized 
the vision-based target tracking and estimation system for both stationary and moving 
targets. A generic set up is shown in Figure 1 below. 
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Figure 1. Flight set-up and PVNT workstation [After: Ref 1]. 

During flight tests, images captured by the onboard camera mounted on the 
SUAV were broadcast and processed by OTS PerceptiVU image processing software 
[Ref 2]. Non-linear filtering algorithms (Figure 2) developed at NPS estimated the target 
geo-location’s accuracy to about 10-20 m with 10-20 seconds of tracking. Working in 
parallel, the images captured from the SUAV and the estimated position of the target 
obtained from the filtering are shared over the network and fed to the PVNT vision-based 
target tracking system. 

The PVNT software compared the images received from the SUAV, together with 
GPS and camera angle coordinates, with the database information. The accuracy of the 
target position is determined almost solely by the accuracy of the database (currently at 1 
m resolution). Thus, using the PVNT-image mensuration system would yield the target 
position estimates to within 1-2 m. However, due to the processing time required in 
comparing the target images with the PVNT database, there would be a time lapse 
(currently about 1 to 10 seconds) between the time the image of the target is fed to the 
PVNT system and the updated position of the target obtained from the PVNT system. 

B. GENERIC ASYCHRONOUS KALMAN FILTER 

In motion tracking, the standard Kalman filter has been extensively employed. 
However, such a filter requires synchronous and equi-distant measurement updates to 
ensure robust and accurate prediction. In many applications, such updates may not be 
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practical or even possible. Many enhancements to the standard Kalman filters were made 
[Ref 5, 6] to accept out-of-sequence, sporadic or infrequent updates to the filter. Such 
filters are typically known as asynchronous filters. 

Asynchronous Kalman filters have been used in various applications. One of the 
more common applications is in sensor fusion. In sensor fusion applications, standard 
and extended Kalman filters are popular due to the ease of blending the various sensors’ 
data to provide an optimal estimate. Sensors measuring target’s velocity and/or 
accelerations can be blended with sensors measuring its direct position to give an optimal 
estimate of the target. However, Kalman filters require specific and consistent 
information for their current iteration in providing accurate prediction of the future states. 
Any interruption in any sensors update rate would degrade the effectiveness of a simple 
Kalman filter. Thus, asynchronous filters are designed to ensure that the effectiveness of 
the Kalman filters is not degraded with asynchronous updates from the sensors. 

The implementation of the asynchronous Kalman filter can also take various 
forms. In the paper “Adaptable Sensor Fusion Using Multiple Kalman Filters” [Ref 7], 
the authors proposed the use of multiple Kalman filters to allow asynchronous inputs 
from sensors. The central idea of the paper is the use of a bank of Kalman filters to 
represent the various combinations of sensors. As the data acquisition rate differs on the 
various sensors, a sensor fusion algorithm allows the selection of the appropriate model 
to account for the new data that is available at each iteration. Such switching alleviates 
the need to receive information from all sensors at every iteration. 

In this thesis, an asynchronous filter is developed to incorporate the delayed but 
more accurate target position estimates from PVNT. 
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III. PROBLEM DEFINITION 


A. CURRENT ARCHITECTURE 





Figure 2. Current architecture 


Figure 2 depicts the current architecture for target tracking using SUAV in NFS. 
A system to track a target and estimate both its velocity and position has been in 
development over the years in NFS. Constant improvements have been made to the 
initial concept of target tracking. The current control system uses a nonlinear filter for 
target estimation [Ref 8]. This filter has shown stability in motion target estimation and 
graceful degradation of performance during target loss events. The filter has been flight 
tested using a moving target and is capable of estimating target position to an accuracy of 
20 meters. Both the target’s velocity and position estimations are available in real time. 

In parallel, the target image captured by the onboard camera of the small UAV is 
sent to the FVNT system as described in Chapter II. From FVNT, the target position 
estimation is expected to be 1-2 meters but with a delay of up to 10 seconds. 
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B. PROBLEM DEFINITION 



In the diagram above, a target is traveling along a simulated road. At time r , the 
eaptured image of the target is sent to PVNT for proeessing. At the same time, the 
nonlinear filter onboard the UAV is proeessing the target image and estimating the 
position of the target. At time t (t > r), when the target has traveled a finite distance 
along the road, an updated target position for time r arrived from PVNT. The present 
filter would not be able to use this information to provide a better estimation of the 
target’s position and velocity. 

C. OBJECTIVES 

To provide a better target motion estimation using the more accurate but delayed 
PVNT position update, a new filter would be designed. This filter would be able to use 
the PVNT position and provide a more accurate velocity and position update at time t. 
To further enhance the filter, this thesis would also examine the performance of the filter 
that incorporates the road profile that the target is traveling on. 
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IV. FILTER DEVELOPMENT 


A. GENERAL ASYNCHRONOUS FILTER 

The following diagram shows the design of the new general asynchronous filter 
that was developed to estimate target motion (both velocity and position) using delayed 
PVNT target position estimation. 
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Figure 4. General asynchronous filter 


1. True Target Vehicle Model 

A true target vehicle model was created in Simulink. It served two purposes. The 
first purpose was to generate the target’s velocity and position vectors in Local Tangent 
Plane. Generated positions of the target were fed to the PVNT model to provide delayed 
position of the target. The second purpose was to compare the target’s actual velocity 
and position with the filter’s estimates. The Simulink model of the true vehicle model is 
shown below. 
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T gtP_true (xyz) 

Figure 5. True target vehicle model 


2. PVNT Model 

The purpose of the PVNT model was to simulate the delayed data received from 
the PVNT software. In Simulink, the PVNT model received position data from the true 
vehicle model, and using a Matlab script file generated delayed target position based on 
the delay timing specified by the user. PVNT noise can also be added to the generated 
target position. A Simulink diagram of the PVNT model is shown below. 



Figure 6. PVNT model 

3. Data Storage 

In the model, a data storage model is generated to store the target’s velocity and 
position data. Both the true and estimated velocity and position are stored. This data is 
marked with a time stamp that allows it to be retrieved based on the time lapse between 
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the current time and the delayed time of the PVNT update. The filter has been designed 
to cater for varying delay times. 

4. Filter 

The Simulink model of the filter that was designed is shown below. 



Figure 7. Simulink model of filter in general asynchronous filter 

This filter uses dead-reckoning when there is no PVNT update. It is initiated 
based on the initial estimate of the target’s velocity and position. The gains (K1 and K2) 
are fixed. When the delayed PVNT update arrives (at time t for data at time r ), the filter 
integrates backward and forward in time (from time r to t) using PVNT delayed data. 
The output from the filter is an updated target velocity and position at time t. Both the 
velocity and position data at time t are used to re-initialize the open-looped filter to 
provide the target’s velocity and position from time t. 

B. ROAD FOLLOWING ASYNCHRONOUS FILTER 

The road following asynchronous filter was developed from the general 
asynchronous filter with some modifications. The diagram shows the Simulink 
representation of the road following asynchronous filter. The main difference for the 
road following asynchronous filter is the use of a parameter, p (path length of the road), 
to characterize the road that the target vehicle is moving on. This parameter is chosen 
because its derivative, p , is the speed of the vehicle at any point on the road. The 
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differences in the various models within the general asynchronous filter and the road 
following asynchronous filter are highlighted in the next few paragraphs. 



Figure 8. Road following asynchronous filter 


1. True Target Vehicle Model with Road Following Characteristics 

The following diagram is the modified true target vehicle model. 



Data storage 


Figure 9. True vehicle model with road following characteristics 
The main difference with the true vehicle model in the road following 
asynchronous filter is the use of the path length parameter to characterize the road. The 
values of the generated true path length as well as the speed of the vehicle are stored to be 
used when the PVNT position update arrives. 
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2. PVNT Model 

The PVNT model for the road following asynchronous filter is the same as the 
one used for general asynchronous filter. 

3. Filter 

The asynchronous filter used in this section is shown in Figure 10. Both the 
inputs and outputs of this filter (shown below) are scalar (path length and speed). 



Figure 10. Simulink model of filter in road following asynchronous filter 

4. Optimization 

An optimization routine is implemented with the road following asynchronous 
filter to determine the path length parameter, p . The minimization equation is as shown. 


min 

p 


{x{p)-xPYm^ ^{y{p) - yPWr)" + (z(/7) - zPVNT)^ 


( 1 ) 
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V. SIMULATION 


A. FRAME REFERENCE 

The frame reference used during the simulation is the Local Tangent Plane (LTP). 

B. DURATION 

The simulation duration is set at 180 seconds. 

C. SAMPLE TIME 

The sample timing used during the simulation is fixed at 0.1 second rate. For a 
simulation of 180 seconds, this equates to 1800 data points. 

D. ROAD MODEL 

In the simulation, the following equations are used to model the road. 

4p)] r p 

Proad= yip) = 0.0000192/?'-0.025p"+9.74p (2) 

Ap). _ 0 

A cubic representation of the road was chosen for the simulation to ensure that the 
profile chosen would not be a monotonically increasing function of the path length. The 
road profile in x-y representation is y = 0.0000192x'-0.025x'+9.74x and a visual 
representation of this road profile is shown in Figure 11. 
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Figure 11. Simulated road profile 


E. MEASURE OF PERFORMANCE (MOP) 

Since the main purpose of both filters is estimation of the motion of the target 
vehicle, the MOP chosen was the root-mean-square (rms) errors between the true motion 
and estimated motion. 


rms error _ velocity = 



( 3 ) 


F. 


rms error _ position = 



( 4 ) 


FILTER COMPARISON 


The performance of the general asynchronous filter and the road following 
asynchronous filter were compared by varying some of the filter parameters. The 
variables include: 

I. KI and K2 Gains 

The fixed gains within the filter are varied from a value of 10 down to 0.1. The 
rms errors in both velocity and position were compared. 
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2. PVNT Delay 

The expected delay from PVNT was randomized with increasing magnitude (from 
1 to 10 seconds). The rms errors in both velocity and position were again compared. 

3. PVNT Noise 

Lastly, the PVNT noise (errors that can be expected from the PVNT software) is 
also varied within each filter. The noise added to the PVNT position ranged from +/- 1 
meter to 5 meters. Similarly, the rms errors in both velocity and position were compared. 
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VI. RESULTS AND ANALYSIS 


A. FILTER PERFORMANCE WITH KI AND K2 VALUES 

To examine the filter performance based on variation of Kl and K2 values, the 
other two parameters were fixed. The PVNT delay is random but does not exceed 1 
second while the PVNT noise is set at +/- 0 meter (i.e. no noise). The Kl and K2 gains 
are fixed at the following values shown in the table below. 


Table 1. Variation of Kl and K2 


Runs conducted 

Kl 

K2 

Run 1 

10 

10 

Run 2 

5 

5 

Run 3 

1 

1 

Run 4 

0.5 

0.5 

Run 5 

0.1 

0.1 


I. Results 

The following four plots show the results obtained for both the general and road 
following asynchronous filters for the rms errors obtained for the target’s velocity and 
position. 


Plot of target's velocity rms error vs K1/K2 values 
(General asynchronous filter) 



□ rms error 


Figure 12. Target velocity rms errors vs K1/K2 values (general asynchronous filter) 
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Figure 13. 


Figure 14. 


Plot of target's position rms error vs K1/K2 values 
(General asynchronous filter) 
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Target position rms errors vs K1/K2 values (general asynchronous filter) 
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Plot of target's velocity rms error vs K1/K2 values 
(Road following asynchronous filter) 
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Target velocity rms errors vs K1/K2 values (road following asynchronous 

filter) 
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Plot of target's position rms error vs K1/K2 values 
(Road following asynchronous filter) 
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Figure 15. Target position rms errors vs K1/K2 values (road following asynchronous 

filter) 


2. Analysis 

For both filters, decreasing the gains from 10 to 0.1 resulted in a decrease in the 
rms errors for both velocity and position estimations. In both filters, the gains K1 and K2 
were activated only when there was a PVNT update. For the simulation, this equates to 
about 10% (180 PVNT updates over 1800 data points) of the simulation time. As such, 
although a smaller gain is desired, the rms errors resultig from the different gains did not 
differ significantly. 

B. FILTER PERFORMANCE WITH PVNT DELAY 

To examine the filter performance based on PVNT delays, the other two 
parameters were fixed. The K1 and K2 values are fixed at 0.5 while the PVNT noise was 
set at +/- 0 meter (i.e. no noise). The PVNT delays are random, but cannot exceed the 
values shown in Table 2. 
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Table 2. Variation of PVNT delays 


Runs conducted 

PVNT delays (seconds) 

Run 1 

1 

Run 2 

2 

Run 3 

3 

Run 4 

5 

Run 5 

10 


1. Results 

The following four plots show the results obtained for both the general and road 
following asynchronous filters for the rms errors obtained for the target’s velocity and 
positions. 



Figure 16. Target velocity rms errors vs PVNT delay (general asynchronous filter) 
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Plot of position rms error vs PVNT delay (K1 = 0.5, K2 = 0.5) 
(General asynchronous filter) 



— rms error 


Figure 17. Target position rms errors vs PVNT delay (general asynehronous filter) 


Figure 18. 



filter) 
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Figure 19. Target position rms errors vs PVNT delay (road following asynchronous 

filter) 

2. Analysis 

From the plots above, the rms error for both the velocity and position increased 
significantly as the PVNT delay time rose. For the general asynchronous filter, the rms 
error for the estimation of target position rose from 10.7722 m (random delay up to 1 
second) to 71.9274 m (random delay up to 10 seconds). This was almost a seven-fold 
increase. The number of PVNT updates for random delay up to 10 seconds is expected to 
be lower than the number of PVNT updates for random delay up to 1 second. As such, 
the general asynchronous filter would rely more on dead reckoning for random delay up 
to 10 seconds, which resulted in the significant increase in errors both in the position and 
velocity estimation. Even for the road following asynchronous filter, both the velocity 
and position estimation showed an increasing trend. The optimization routine, though 
able to reduce the magnitude of the velocity and position’s rms error significantly as 
compared to the general asynchronous filter, was unable to prevent the increased in rms 
error from increasing as the PVNT delay increased. 
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c. 


FILTER PERFORMANCE WITH PVNT NOISE 

To examine the filter performance based on PVNT noise, the other two 


parameters were fixed. The K1 and K2 values were fixed at 0.5 while the PVNT delay 
was random but did not exceed 1 meter. The PVNT noise was fixed at the following 
values shown in the table below. 


Table 3. Variation of PVNT noise 


Runs conducted 

PVNT noise (meter) 

Run 1 

±0 

Run 2 

± 1 

Run 3 

± 2 

Run 4 

± 3 

Run 5 

± 5 


I. Results 

The following four plots show results obtained for both the general and road 
following asynchronous filters for the rms errors obtained for the target’s velocity and 
positions. 


Plot of velocity rms error vs PVNT noise (K1 = 0.5, K2= 0.5) 
(General asynchronous filter) 
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Figure 20. Target velocity rms errors vs PVNT noise (general asynchronous filter) 
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Figure 21. 


Figure 22. 


Plot of position rms error vs PVNT noise (K1 = 0.5, K2 = 0.5) 
(General asynchronous filter) 


.t: 

(/> 

o 

CL 


10.786 

10.784 

10.782 

10.780 

10.778 

10.776 

10.774 

10.772 

10.770 


10.7847 


10.7778 


10.7734 

10.7722 








10.7753 


PVNT noise (in) 


□ rms error 


Target position rms errors vs PVNT noise (general asynchronous filter) 


Plot of velocity rms error vs PVNT noise (K1 = 0.5, K2 = 0.5) 
(Road following asynchronous filter) 
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Target velocity rms errors vs PVNT noise (road following asynchronous 

filter) 
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Plot of position rms error vs PVNT noise (K1 = 0.5, K2= 0.5) 
(Road following asynchronous filter) 
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Figure 23. Target position rms errors vs PVNT noise (road following asynchronous 

filter) 
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2. Analysis 

For the general asynchronous filter, the increase in PVNT noise value caused an 
increase in the rms error for both the velocity and position estimation. However, the 
magnitude of increase was not significant. The trend for the road following 
asynchronous filter was similar and the increase was smaller than the general 
asynchronous filter. The accuracy of the PVNT position update (within +/- 1 to 5 m) was 
much smaller than the variation in the x and y distance traveled by the target on the 
simulated road during simulation. As such, the filter was able to re-initialize itself to a 
fairly accurate position provided by PVNT. The road following asynchronous filter was 
able to provide a more accurate prediction of the position of the target and used it to re¬ 
initialize the filter. Thus, its rms error for both velocity and position were almost 
constant for PVNT noise up to 3 meters. 

D. GENERAL ASYNCHRONOUS FILTER PERFORMANCE 

The general asynchronous filter was run with the following parameters: K1 = K2 
= 0.5, PVNT delay = random up to 1 second, PVNT noise = +/- 3 meters. The plots for 
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the true and estimated velocity and position were plotted below. The rms errors were 
also plotted. 

Plot of actual vs estimated tai get position 
(K1 = K2 = 0.5, PVHT delay = i andom up to 1 sec, PVMT noise = +/- 3 m) 



Px (ill) 


— '—Actual Position —^— Estimated Position 


Figure 24. Actual vs Estimated target position (general asynchronous filter) 


Plot of errors in t,iiget position (x position) 

(K1 = K2 = 0.5, PVHT delay = random up to 1 sec, PVHT noise = +/- 3 m) 
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Figure 25. Errors in x-direction position (general asynchronous filter) 
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Plot of etiots in taiget position (y position) 

<K1 = K2 = 0.5. PVUT delay = landom up to 1 sec. PVIIT noise = +.- 3 m) 



Py errors 


Figure 26. Errors in y-direction position (general asynchronous filter) 


From the position plots above, it can be seen that the main errors occurred at the 
beginning of the road and toward the end of the road. In these two sections of the road, 
the change in gradients was the greatest. The general asynchronous filter, without the 
knowledge of the road profile, could only rely on the last PVNT position update to 
estimate the future target’s position. As such, with the steeper change in road gradient, 
the performance of the filter would not be as good as it was when the change in gradient 
of the road was more gradual (toward the center part of the road). 
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Figure 27. 


Figure 28. 


Plot of actual vs estimated Vi profile 
(K1 = K2 = 0.5. PVNT delaj = random up to 1 sec. PVNT 
noise = *i- 3 m) 



Time (s) 


—►— Vx true —^— Vx est 


Velocity profile in the x-direction (general asynchronous filter) 


Plot of eirors in Vx profile 

(K1 = K2 = 0.5, PVNT delay = random up to 1 sec. PVNT 
noise = +■- 3 m) 



Time (s) 


■ Vx errors 


Error in the x-direction velocity (general asynchronous filter) 
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Plot o( actual vs estimated Vg profile 
(K1 = K2 = 0.5. PVNT delag = random up to 1 sec. PVNT 
noise = •!- 3 m) 



—► — Vyjrue —^— Vy_est 


Figure 29. Velocity profile in the y-direction (general asynchronous filter) 


Plot of eirors in Vy profile 
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Figure 30. Error in the y-direction velocity (general asynchronous filter) 





* 



- 




c 

12.3 

24.6 

36.9 

111 

123 

135 

148 

160 

172' 

i 




Time (s) 


4 — Vy errors 


31 






































From the velocity plots above, the major velocity errors occurred when the 
change in gradient was the highest. The prediction of the target’s velocity was similar to 
its position estimation and the errors generated were also similar when there was a large 
change in gradient of the profiles. 

E. ROAD FOLLOWING ASYNCHRONOUS FILTER PERFORMANCE 

The road following asynchronous filter was run with the following parameters: 
K1 = K2 = 0.5, PVNT delay = random up to 1 second, PVNT noise = +/- 3 meters. The 
plots for the true and estimated velocity and position were plotted below. The rms errors 
were also plotted. 



Figure 31. Actual vs Estimated target position (road following asynchronous filter) 
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Plot of errors in target position (x position! 

(K1 = K2 = 0.5, PVIIT delay = rairdom up to 1 sec, PVNT noise = +/- 3 m) 
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Figure 32. Errors in x-direction position (road following asynchronous filter) 


Plot of errors in target position (x position) 

|K1 = K2 = 0.5, PVIIT delay = random up to 1 sec. PVIIT noise = +■- 3 m) 
[Expanded view] 
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Figure 33. Expanded plot for errors in x-direction position (road following asynchronous 

filter) 
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Plot of errors in target position |y position) 

(K1 = K2 = 0.5. PVIIT delay = random up to 1 sec. PVIIT noise = +,■- 3 m) 



^ Py errors 


Figure 34. 


Errors in y-direction position (road following asynchronous filter) 


Plot of errors in target position (y position) 

(K1 = K2 = 0.5, PVIIT delay = random up to 1 sec, PVIIT noise = + - 3 m) 
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Figure 35. Expended plot for errors in y-direction position (road following asynchronous 

filter) 

34 































Based on the parameters specified for the simulation, the road following 
asynchronous filter was able to provide very accurate position estimation. Both the x and 
y direction errors were close to zero. This road following asynchronous filter showed a 
vast improvement as compared to the general asynchronous filter. The knowledge of the 
road profile allowed the optimization routine to further reduce the error that the PVNT 
position estimate provided. The filter was able to integrate along the road provided and 
gave very accurate target position estimation. 


Plot of actual vs estimated Vi profile (road following) 
(K1 = K2 = 0.5, PVNT delaj = random delaj up to 1 sec, 
PVNT noise = *i- 3 m) 



—► — Vx true —^— Vx est 


Figure 36. Velocity profile in the x-direction (road following asynchronous filter) 
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Plot of errors in Vx profile 

(K1 = K2 = 0.5, PVIIT del,iy = r,indom del,iy up to 1 sec, 
PVIIT noise = +■- 3 m) 



Time (s) 


—♦— Vx errors 


Figure 37. Error in the x-direction velocity (road following asynchronous filter) 
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Figure 38. Velocity profile in the y-direction (road following asynchronous filter) 
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Plot of errors in Vy profile 

(K1 = K2 = 0.5, PVIIT (lel,iy = r.indom <lel.iy up to 1 sec, 
PVIIT noise = + - 3 m) 



Time (s) 


—♦— Vy errors 

Figure 39. Error in the y-direction velocity (road following asynchronous filter) 

The target’s velocity estimation was very accurate using the road following 
asynchronous filter. The filter was able to use the derivative of the path length (i.e., 
speed) to estimate the target’s velocity. Due to the accuracy provided by the 
minimization routine in obtaining the path length, its derivative yields accurate velocity 
estimation. 
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VII. CONCLUSION AND RECOMMENDATION 


A. CONCLUSION 

The task of designing an asynchronous filter was achieved in this thesis. The 
asynchronous filter was able to use the delayed PVNT target position updates that arrived 
about 1 to 10 seconds later to refine the target’s motion estimation. This simple filter has 
shown its capability to estimate target motion in simulation. Furthermore, the general 
asynchronous filter was modified to allow the incorporation of a road model. This 
allowed a better prediction of target motion as the target’s motion is expected to be along 
the road that it is traveling on. In simulation, it was shown that this modified filter could 
estimate the target’s velocity and position very accurately. 

B. RECOMMENDATION 

The new asynchronous filter worked well in simulation. In the future, this filter 
could be incorporated in the hardware and be bench-tested. Further test in actual SUAV 
flight could be conducted once bench testing has shown promising results. 

The asynchronous filter could also be combined with the current non-linear filter 
so that the two complement each other during target motion estimation. The advantage 
of the asynchronous filter is in its ability to use the delayed but more accurate PVNT 
update to provide a better target velocity and position estimation at current time. This 
information could be used to re-initialize the nonlinear filter to enhance its performance 
such that the current 10 - 20 m accuracy could be reduced. 
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